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SPACECRAFT  DEBRIS  AVOIDANCE  USING  POSITIVELY 
INVARIANT  CONSTRAINT  ADMISSIBLE  SETS 

Morgan  Baldwin*  Avishai  Weiss]  Ilya  Kolmanovsky]  R.  Scott  Erwin§ 


To  cope  with  the  growing  amount  of  debris  in  the  Earth  orbit,  spacecraft  collision 
avoidance  capabilities  are  necessary.  In  this  paper,  we  propose  an  approach  to 
debris  avoidance  maneuvering  based  on  the  use  of  safe  positively  invariant  sets  in 
order  to  steer  the  spacecraft,  under  closed-loop  control,  around  a  piece  of  debris.  A 
connectivity  graph  of  forced  equilibria  is  computed  based  on  the  overlap  of  these 
invariant  sets,  and  a  graph  search  algorithm  is  then  implmented  in  order  to  find 
the  shortest  path  around  the  debris.  Fast  growth  distance  computation  is  employed 
for  on-board  real-time  applicability.  Simulation  results  are  presented  that  illustrate 
this  approach. 

INTRODUCTION 

More  than  22,000  identifiable  objects,  mostly  debris,  are  being  tracked  today  in  space  and  many 
of  them  represent  spacecraft  collision  risk.  Motion  planning  problems  with  debris  avoidance  have 
been  studied  in  robotics  applications1-2  for  many  years.  Related  problems  in  spacecraft  applica¬ 
tions  have  several  unique  features.  Firstly,  the  environment  is  relatively  uncluttered  as  compared  to 
typical  robotics  applications.  This  gives  an  opportunity  to  perform  fuel  efficient  debris  avoidance 
maneuvers.  The  minimization  of  fuel  consumption  and  maneuver  efficiency  arc  very  important 
in  spacecraft  applications.  Excessive  use  of  fuel  can  shorten  spacecraft  mission  life,  even  if  the 
debris  collisions  arc  avoided.  Secondly,  the  spacecraft  dynamics  and  orbital  motions  arc  quite  dif¬ 
ferent  from  those  of  typical  robots  while  the  control  authority  of  spacecraft  thrusters  is  very  limited. 
Thirdly,  the  position  of  the  debris  and  the  states  of  the  spacecraft  arc  estimated  but  may  not  be 
accurately  known.  Fourth,  fast  computational  algorithms  arc  necessary  for  deployment  within  the 
control  units  of  small  satellites.  Fifth,  spacecraft  may  be  flying  alone  or  in  formation  and  may 
need  to  avoid  multiple  debris  that  may  be  moving  relative  to  the  spacecraft.  These  unique  features 
lead  to  both  challenges  and  opportunities  in  the  development  of  specific  and  effective  maneuvering 
solutions  for  spacecraft  applications. 

The  interest  in  spacecraft  trajectory  optimization  with  obstacle  avoidance  has  increased  in  recent 
years.  In  Ref.  3,  this  problem  was  formulated  as  an  optimal  control  problem  with  path  constraints 
constructed  as  ’keep  out’  zones  to  avoid  obstacles.  The  SOCS  software  was  then  used  to  solve 
the  problem.  An  optimal  control  problem  formulation  was  used  in  Ref.  4  to  solve  the  minimum- 
fuel  rendezvous  between  a  chief  and  deputy  vehicle.  Collision  avoidance  constraints  were  added  to 
the  problem  in  the  form  of  inequality  constraints,  resulting  in  an  inequality  constrained,  nonlinear 
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programming  problem.  The  method  involved  solving  a  sequence  of  unconstrained  optimal  control 
problems,  whose  solution  converges  to  the  solution  of  the  original  problem.  Maneuver  avoidance 
strategies  have  also  been  determined  utilizing  collision  avoidance  probabilities.  Ref.  5  presents 
collision  avoidance  strategies  based  upon  the  number  of  evasive  maneuvers,  expected  risk  reduction, 
false  alarm  rate,  and  required  propellant  consumption  and  mass  fraction  for  an  accepted  collision 
probability. 

Artificial  potential  function  guidance  is  used  in  Ref.  6  and  7  to  determine  a  rendezvous  solution 
on  a  path  free  of  obstacles.  A  potential  function  is  developed  with  the  intent  that  a  minimum  occurs 
at  a  desired  relative  position  and  then  a  dynamic  control  law  is  used  to  ensure  the  trajectory  is 
obstacle  free.6  A  3-D  static  optimization  over  final  relative  position  and  time-of-flight  such  that 
obstacles  arc  avoided  and  cost  is  optimized  is  presented  in  Ref.  7.  Feedback  is  incorporated  by 
re -planning  over  either  constant  or  variable  time  intervals. 

The  spacecraft  obstacle  avoidance  problem  has  also  been  treated  using  linear  programming  tech¬ 
niques.8’9'  10' 1 1  In  Ref.  8,  the  minimum-fuel  avoidance  maneuver  problem  is  formulated  with  linear 
constraints  and  discrete  dynamics  modeled  as  a  linear,  time-varying  system.  The  trajectory  opti¬ 
mization  problem  is  formulated  as  a  linear  programming  problem  with  the  capability  of  including 
operational  constraints  and  the  optimal  number  of  maneuvers  is  determined  in  Ref.  9.  A  mixed- 
integer  lineal-  program  results  from  combining  collision  avoidance,  trajectory  optimization,  and  fleet 
assignment  to  obtain  the  optimal  solution  for  spacecraft  maneuvers  as  shown  in  Ref.  10.  A  robust 
lineal’  programming  technique  is  proposed  in  Ref.  11.  The  maneuver  can  be  constructed  by  solving 
a  lineal’  programming  problem  with  no  integer  constraints  and  guaranting  collision  avoidance  with 
respect  to  bounded  navigation  uncertainty. 

Our  approach  in  this  paper  is  based  on  the  use  of  constraint-admissible  positively  invariant  sets12 
centered  around  forced  and  unforced  spacecraft  equilibria  in  the  HCW  (relative  motion)  frame,13 
and  corresponding  to  different  choices  of  the  Linear  Quadratic  (LQ)  control  gain.  The  finite  set 
of  these  equilibria  used  for  constructing  debris  avoidance  maneuvers  is  referred  to  as  a  virtual  net. 
Given  an  estimate  of  the  debris  position,  we  build  on-line  a  connectivity  graph  that  identifies  the 
equilibria  in  the  virtual  net  between  which  the  spacecraft  can  move,  with  guaranteed  collision-free 
and  thrust-limited  motions.  The  construction  of  the  connectivity  graph  is  based  on  fast  growth 
distance  computation  between  two  ellipsoidal-type  sets.  We  then  employ  real-time  graph  search 
algorithms  to  determine  an  efficient  path  between  the  equilibria  and  control  gains  used  that  permit 
debris  avoidance.  Simulation  results  are  reported  that  illustrate  the  approach. 

In  our  approach  we  do  not  rely  on  precise  assignment  of  spacecraft  position  to  the  time  instants 
along  the  trajectory  but  wait  for  the  appropriate  conditions  to  switch  to  the  next  set-point  and  con¬ 
troller  gain.  This  approach  is  conservative  and  may  facilitate  fault-tolerant  and  disturbance-tolerant 
execution  of  the  maneuvers. 

RELATIVE  MOTION  MODEL 

In  the  traditional  treatment  of  the  relative  motion  problems,  the  spacecraft  motion  is  considered 
relative  to  the  (non-inertial)  Hill’s  frame  with  the  origin  at  a  target  location  on  the  nominal  orbit.  For 
generic  elliptic  orbits,  the  linearization  of  the  nonlinear  equations  of  motion  equations  yields  a  set 
of  lineal’  time-varying  Tschauner-Hempel  (TH)  equations.  For  circular  orbits,  these  TH  equations 
reduce  to  the  well  known  linear  time-invariant  Clohessy-Wiltshire-Hill  (CWH)  equations.  See  Ref. 
13.  A  nominal  circular  orbit  is  assumed  in  this  work. 
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Nonlinear  equations  of  motion 

The  relative  position  vector  of  the  spacecraft  with  respect  to  a  target  location  on  a  circular  orbit 
is  expressed  as 

Sr  =  xi  +  yi  +  zk, 


where  x,  y  and  z  are  the  components  of  the  position  vector  of  the  spacecraft  relative  to  the  target 
location  and  i,  j,  k  are  the  unit  vectors  of  the  Hill’s  frame.  The  Hill’s  frame  has  its  x-axis  along  the 
orbital  radius,  y-axis  along  the  orbital  track,  and  ,2-axis  orthogonal  to  orbital  plane.  The  position 
vector  of  the  spacecraft  with  respect  to  the  center  of  the  Earth  can  be  expressed  as  R  =  Rq  +  Sr  = 
(Rq  +  x)i  +  yj  +  zk,  where  Rq  is  the  nominal  orbital  radius.  The  nonlinear  equations  of  motion  for 
the  spacecraft  (relative  to  an  inertial  frame)  can  be  expressed  in  vector  form  as 


i  =  +  —  F,  (1) 

R 6  mc 

where  F  is  the  vector  of  external  forces  applied  to  the  spacecraft,  R  =  R\,  mc  is  the  mass  of  the 
spacecraft,  y  is  the  gravitational  constant,  and 


R=  (x  —  2  ny  —  3  n2x)i  +  (y  +  2  nx)j  +  (z  +  n2z)k. 


In  these  equations,  n  =  /^denotes  the  mean  motion  of  the  nominal  orbit.  Similar  equations  can 


be  used  to  describe  the  motion  of  the  debris. 


Linearized  HCW  equations  in  discrete-time 


For  Sr  «  R,  the  linearized  HCW  equations13  approximate  the  relative  motion  of  the  spacecraft 
on  a  circular  orbit  as 

2  Cx 

x  —  3n  x  —  2 ny  =  — , 
mc 

y  +  2  nx  =  — ,  (2) 

771, c 

2  F- 
z  —  3  iRz  =  — , 
mc 


where  Fx  ,Fy.Fz  are  components  of  the  external  force  vector  (excluding  gravity)  acting  on  the 
spacecraft. 

Assuming  a  sampling  period  of  AT  sec,  we  can  convert  the  model  (2)  to  a  discrete-time  form 


X(t  +  l)  =  AX(t)  +  BU(t),  (3) 

where  X(t)  =  [x(t),  y(t ),  z(t),  x(t),  y(t),z(t)]T  is  the  state  vector  at  the  time  instant  t  €  Z+, 
U (t)  =  [ Fx(t ),  Fy(t ),  Fz(t)]T  is  the  control  vector  of  thrust  forces  at  the  time  instant  t  G  Z+,  and 
A,  B  arc  the  discretized  matrices  obtained  from  HCW  equations.  Alternatively,  the  control  vector 
U  can  represent  an  instantaneous  change  in  the  velocity  of  the  spacecraft.  An,  induced  by  thrust, 
with  an  appropriately  re-defined  /i -matrix. 
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DEBRIS  AVOIDANCE  BASED  ON  A  VIRTUAL  NET 


In  this  paper  we  treat  a  spacecraft  motion  planning  problem  with  debris  avoidance.  We  initially 
assume  that  the  debris  is  stationary  relative  to  the  spacecraft.  The  case  of  moving  debris  will  be 
discussed  later  in  the  paper. 

Our  approach  to  debris  avoidance  is  based  on  utilizing  constraint-admissible  positively  invariant 
sets12,14  centered  around  the  spacecraft  forced  and  unforced  equilibria.  A  finite  set  of  these  equi¬ 
libria  used  for  constructing  debris  avoidance  maneuvers  is  referred  to  as  a  virtual  net.  Given  an 
estimate  of  the  debris  position,  we  build  a  connectivity  graph  that  identifies  the  equilibria  in  the  vir¬ 
tual  net  between  which  the  spacecraft  can  move,  with  guaranteed  collision-free  motion  and  within 
the  available  thrust  authority.  We  then  employ  graph  search  to  determine  an  efficient  path  between 
the  equilibria  that  permits  debris  avoidance. 


Virtual  Net 


The  virtual  net  comprises  a  finite  set  of  equilibria,  Xe(r),  corresponding  to  a  finite  set  of  pre¬ 
scribed  spacecraft  positions  r  E  AT  =  {ri,  7*2, . . . ,  rn}  C  /i3, 


Xe(rk)  = 


T"kx 

rky 

fkz 

0 

0 

0 


k  =  1,  •  •  •  ,n. 


(4) 


See  Figure  1.  We  assume  that  for  all  r  E  A f,  the  corresponding  values  of  control  necessary  to 
support  the  specified  equilibria  in  steady-state  satisfy  the  imposed  thrust  limits. 


LQ  Controller  with  Gain  Switching 


A  conventional  Linear-Quadratic  (LQ)  feedback  is  used  to  control  the  spacecraft  to  a  commanded 
equilibrium  in  (4), 


U  =  K(X  -  Xe(r))  +  Tr  =  KX  +  H(K)r , 


(5) 
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where 


—3  n2mc  0  0 

T  =  0  0  0 

0  0  3n2mc 

H(K)  =  T-K  ^  , 

and  where  I3  denotes  the  3x3  identity  matrix  and  O3  denotes  the  3x3  zero  matrix.  This  LQ 
controller  provides  an  asymptotically  stable  closed-loop  system  but  does  not  enforce  the  constraints. 

To  provide  greater  flexibility  in  handling  constraints,  a  multimode  controller  architecture  is  em¬ 
ployed.  14  Specifically,  we  assume  that  a  finite  set  of  LQ  gains  K  £  /C  =  {K\ ,  •  •  •  ,  Krn  }  is  available 
to  control  the  spacecraft.  By  using  a  large  control  weight  in  the  LQ  cost  functional,  motions  with 
low  fuel  consumption  yet  large  excursions  can  be  generated;  using  a  large  control  weight  in  the  LQ 
cost,  motions  with  short  transition  time  can  be  generated.15  We  assume  that  a  preference  ordering 
has  been  defined  and  the  gains  are  arranged  in  the  order  of  descending  preference,  from  K\  being 
the  highest  preference  gain  to  Krn  being  the  lowest  preference  gain. 

Positively  Invariant  Sets 

The  ellipsoidal  set 

C(r,K)  =  {XeR6:  ±(X  -  Xe(r))T  P(K )(X  -  Xe(r))  <  1}  C  R 6,  (6) 

where  (A+BK)T  P(A+BK )  —P  <  0,  P  =  P{K )  >  0,  is  positively  invariant.  Positive  invariance 
implies  that  any  trajectory  of  the  closed-loop  system  that  starts  in  C(r,  K)  is  guaranteed  to  stay 
in  C(r,K )  as  long  as  the  same  LQ  gain  K  is  used  and  the  set-point  command  r  is  maintained. 
To  achieve  the  positive  invariance,  the  matrix  P  can  be  the  solution  of  the  discrete-time  Riccati 
equation  or  the  above  Lyapunov  equation  for  the  closed-loop  asymptotically  stable  system.  We  note 
that  because  the  system  is  linear,  the  positive  invariance  of  C(r,  K)  implies  the  positive  invariance 
of  the  scaled  set 

C(r,K,p)  =  {X  eR6  :  l-(X  -  Xe{r))T P(K){X  -  Xe{r))  <  p2},  p>  0  (7) 

Geometrically,  the  set  C  (r,  K,  p)  corresponds  to  an  ellipsoid  scaled  by  the  value  of  p  and  centered 
around  Xe(r),  r  £  AT. 

Debris  Representation 

We  use  a  set,  0(z,  Q ),  centered  around  the  position  z  £  R'\  to  over-bound  the  position  of  the 
debris,  i.e., 

0(z,  Q)  =  {X  €R6  :  ( SX  -  z)tQ(SX  -  z)  <  1},  Q  =  QT  >  0,  (8) 

where 

'  1  0  0  0  0  0  ' 

S=  0  1  0  0  0  0  .  (9) 

_  0  0  1  0  0  0  _ 

This  set  can  account  for  the  debris  and  spacecraft  physical  sizes,  and  also  for  the  uncertainties  in 
the  estimation  of  the  debris/spacecraft  position.  Note  that  the  set  0(z,  Q)  has  an  ellipsoidal  shape 
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in  the  position  directions  and  it  has  a  cylindrical  shape  in  the  velocity  directions.  Ellipsoidal  sets 
rather  than  polyhedral  sets  are  used  to  over-bound  the  debris  since  ellipsoidal  bounds  are  typically 
produced  by  position  estimation  algorithms,  such  as  the  Extended  Kalman  Filter  (EKF). 

Debris  Avoidance  Approach 

Consider  now  rt  E  Af,  representing  a  possible  position  on  the  net  that  the  spacecraft  can  move 
to  as  a  part  of  the  obstacle  avoidance  maneuver.  Suppose  that  the  current  state  of  the  spacecraft  is 
X(to)  at  the  time  instant  to  E  Z+.  If  there  exists  a  p  >  0  and  Kj  E  K.  such  that 

X(t0)  E  C(ri,Kj,p)  and  0(z,Q)  Cl  C(ri,Kj,p)  =  0,  (10) 

the  spacecraft  can  move  to  the  position  rt  E  Af  by  engaging  the  control  law  with  r(t)  =  r*  and 
K(t)  =  Kj,  t  >  to,  and  without  hitting  the  debris.  This  idea  underlies  our  subsequent  approach  to 
debris  avoidance,  where  we  maintain  the  spacecraft  trajectories  within  the  tube  formed  by  positively 
invariant  sets  that  do  not  overlap  with  the  debris. 

Growth  Distances 

The  minimum  value  of  p  >  0  for  which  (){z.  Q)  fj  C{r,  K ,  p)  /  0  is  referred  to  as  the  growth 
distance,  similarly  to  Ref.  16.  This  growth  distance  can  also  be  viewed  as  the  least  upper  bound 
on  the  values  of  p  for  which  0(z,  Q )  and  C(r,  K,  p)  do  not  intersect.  See  Figure  2.  We  use  the 
notation  p9(r,  K,  Q,  z )  to  reflect  the  dependence  of  the  growth  distance  on  the  set-point  r  E  AT,  the 
control  gain  I\  E  /C  and  the  obstacle  parameters  Q  and  z. 

Note  that  the  growth  distance  depends  on  the  position  of  the  debris  which  may  be  unknown  in 
advance.  Consequently,  the  growth  distance  computations  have  to  be  performed  online. 


Figure  2:  The  positively  invariant  set  is  grown  till  touching  the  debris.  The  spacecraft  can  move 
from  any  of  the  equilibria  on  the  virtual  net  inside  the  positively  invariant  set  C(r,  K,  p)  to  Xe(n) 
marked  by  ’x’  without  colliding  with  the  debris. 

Since  the  spacecraft  maneuvers  have  to  be  performed  using  limited  thrust,  we  additionally  define 
a  maximum  value  of  p  =  pu(r,  K )  for  which  X  E  C(r.  K,  pu(r ,  K))  implies  that  the  thrust  U  = 
K X  +  H(K)r  satisfies  the  imposed  thrust  limits.  We  refer  to  pu  as  the  thrust  limit  on  growth 
distance.  Unlike  pg,  the  value  of  pu  does  not  depend  on  the  position  or  shape  of  the  obstacle  and 
can  be  pre-computed  off-line.  Suppose  that  the  thrust  limits  are  expressed  in  the  form  ||L£/||  <  1 
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for  an  appropriately  defined  matrix  L  and  norm  1 1  •  1 1 .  The  computational  procedures  to  determine 
pu  (r.  K)  involves  solving  a  bilevel  optimization  problem  where  \  \L(KX  +  H(K)r)  1 1  is  maximized 
subject  to  the  constraint  I  £  C(r,  K,  a)  and  bisections  are  performed  on  the  value  of  a  so  that  the 
maximum  value  is  driven  to  1. 

Finally,  we  define  the  thrust  limited  growth  distance 

p*(r,K,Q,z)  =  min {p9(r,  K,Q,  z),  pu(r,  K)}.  (11) 

Note  that  X(to)  £  C(ri,Kj,  p*(ri,Kj,  z ))  implies  that  the  ensuing  closed-loop  spacecraft  trajec¬ 
tory  under  the  control  (5)  with  r(t)  =  r*  and  K(t)  =  Kj  for  t  >  to  satisfies  the  thrust  limits  and 
avoids  debris  collisions. 

Connectivity  Graph  and  Graph  Search 

We  now  introduce  a  notion  of  connectivity  between  two  vertices  of  the  virtual  net,  ry  £  Af  and 
rj  G  Af.  The  vertex  rt  is  connected  to  the  vertex  r;  if  there  exists  a  gain  K  <£  K,  such  that 

Xe(n)  £  intC(rj,K,p*(rj,K,z)).  (12) 

The  connectivity  implies  that  a  spacecraft  located  close  to  an  equilibrium  corresponding  to  rt  can 
transition  to  an  equilibrium  Xe{rj)  by  using  limited  thrust  and  avoiding  collision  with  the  debris. 
We  note  that  if  r,  is  connected  to  rj  this  does  not  imply  that,  in  turn,  r?  is  connected  to  r,;.  We  also 
note  that  connectivity  depends  on  the  existence  of  an  appropriate  control  gain  from  the  set  of  gains 
Kf  but  the  condition  (12)  does  not  need  to  hold  for  all  gains. 

The  on-line  motion  planning  with  debris  avoidance  is  performed  according  to  the  following  pro¬ 
cedure: 

Step  1  :  Determine  the  debris  location  and  shape  (i.e.,  z  and  Q). 

Step  2:  By  using  fast  growth  distance  computations,  determine  thrust  limited  growth  distance  based 
on  (1 1),  with  pg  computed  online  and  pu  pre-computed  off-line. 

Step  3:  Construct  a  graph  connectivity  matrix  between  all  r% ,  ry  £  Af.  In  the  graph  connectivity 
matrix,  if  two  vertices  arc  not  connected,  the  corresponding  matrix  element  is  zero;  if  they  arc 
connected  the  corresponding  matrix  element  is  1.  In  parallel,  build  the  control  gain  selectivity 
matrix,  which  identifies  the  index  of  the  highest  preference  gain  K  for  which  rr  and  ry  arc 
connected.  This  gain  will  be  applied  if  the  edge  connecting  r,  and  ry  is  traversed. 

Step  4:  Perform  graph  search  to  determine  a  sequence  of  connected  vertices  r[k]  £  Af  and  control 
gains  K[k]  £  1C,  k  =  1,  •  •  ■  ,  lp,  such  that  r[l]  satisfies  the  initial  constraints,  r[lp\  satisfies 
the  final  constraints,  and  the  path  length  lp  is  minimized. 

Per  the  above  algorithm,  a  graph  search  is  utilized  to  determine  the  minimum  number  of  equi¬ 
librium  hops  around  a  piece  of  debris.  After  the  path  has  been  determined  as  a  sequence  of  the 
set-points  and  the  corresponding  control  gains,  the  execution  of  the  path  proceeds  by  checking  if 
the  current  state,  X (t)  is  in  the  safe  positively  invariant  set  corresponding  to  the  next  reference  r+ 
and  next  control  gain  K+  in  the  sequence;  if  it  is,  then  the  controller  switches  to  this  reference  and 
control  gain: 

X{t)  £  C(r+,K+,p*(r+,K+,z))  ->  r{t)  =  r+,  K(t)  =  K+ . 
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Growth  Distance  Computations 

The  fast  online  growth  distance  computation  can  greatly  facilitate  the  implementation  of  the  pro¬ 
posed  approach. 

For  given  z  G  R3,  r  G  R3  and  K  G  /C,  the  growth  distance  is  the  minimum  value  of  p  >  0 
for  which  0(z )  fj  C(r.  K,  p)  /  0.  To  determine  the  growth  distance,  one  enlarges  C(r.  K,  p)  by 
changing  p  until  touching  O(z).  Since  C(r,  K ,  p)  is  compact  and  0(z)  is  closed,  it  can  be  shown 
that  the  growth  distance  exists  and  is  well-defined. 

Define  X  =  X  —  Xe(r)  and  a  =  2 p2.  The  problem  of  determining  the  growth  distance  reduces 
to  the  following  constrained  optimization  problem: 

min  a 

a,X 

(13) 

subject  to  XTPX  <  a 

((S(X  +  Xe(r))  -  z)tQ((S(X  +  Xe(r))  -z)<l. 

To  solve  this  optimization  problem,  we  use  the  Karush-Kuhn-Tucker  (KKT)  conditions.  Note 
that  the  standard  linear  independence  constraint  qualification  conditions  hold  given  that  P  >  0.  We 
define 


C  =  a  +  X1(XTPX  -a) 

+  A 2((S(X  +  Xe(r))  -  z)tQ(S(X  +  Xe(r))  -  z)  -  1), 

where  Ai  and  A2  arc  Lagrange  multipliers.  The  stationarity  of  the  Lagrangian  (setting  partial  deriva¬ 
tive  equal  to  zero)  with  respect  to  a  leads  to  the  condition  Ai  =  1.  The  stationarity  of  the  Lagrangian 
with  respect  to  X  leads  to 

PX  +  A 2StQSX  +  A 2STQ{SXe{r)  -  z)  =  0, 

or 

X  =  X(A2,  r,  z)  =  -(P  +  A 2STQS)~1STQ(SXe(r)  -  z) A2,  (14) 

where  A2  >  0  is  a  scalar  to  be  determined.  Note  that  P  >  0,  STQS  >  0,  A2  >  0  (as  the  Lagrange 
multiplier  corresponding  to  an  inequality  constraint)  imply  that  ( P  +  X'jS  ^  QS)  is  invertible. 

A  computational  procedure  to  determine  the  growth  distance  can  now  be  defined  based  on  the 
bisections  approach.  Specifically,  the  bisections  can  be  performed  to  find  a  nonnegative  scalar  A2 
which  is  the  root  of  the  equation 


F( A2,  r,  z)  =  ((SX  -  z)TQ(SX  -  z)  -  1  =  0, 


(15) 


where 

X  =  X(X  2,r,z)  +  Xe(r). 

Computationally,  these  bisections  to  find  A2  can  be  performed  rapidly. 

An  alternative  procedure  to  using  bisections  is  to  apply  a  Newton-Raphson  method  to  determine 
the  unknown  A2  in  the  nonlinear  equation  (15).  Since  the  computations  of  the  growth  distance 
need  to  be  performed  for  different  r  G  Af  and  possibly  z  (in  the  case  the  debris  is  moving),  we 
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propose  an  even  faster  approach  than  bisections  to  the  distance  computation  based  on  viewing  the 
above  root  finding  problem  as  a  functional  root-finding  problem  where  the  parameters  are  z  and  r. 
Unlike  conventional  root  finding  problem,  in  a  functional  root  finding  problem,  a  root  needs  to  be 
determined  as  a  function  of  a  parameter. 

Consider  an  iterative  update  procedure  for  A2  in  response  to  changes  in  z  and  r.  Let  the  super¬ 
script  k  denote  the  A  th  iteration.  As  the  Newton-Raphson’s  approach  is  based  on  setting  a  first  order 
approximation  of  F  to  zero,  we  consider  the  following  approximate  equation 


F(A^+1, 


k-\- 1  Ai+In 


dF 


+ 


F(Xk,zk,rk)  +  ^-(A*,zVfc)(A*+i  -  A£) 

^(A lzk,rk)(zk+1  -  zk)  +  ^(A k,zk,rk)(rk+1  -  rk) 


=  0. 


Solving  this  equation  leads  to  a  predictor-corrector  update  algorithm  of  the  form, 

8F 


\  fc+i  _ 

a2 


=  +  {  —  (Xl  zk,  r^j-'i-Fi  Xk,  zk ,  rk) 

^-(Xtzk,rk)(zk+1  -  zk)  -  tzk,rk)(rk+1  -rk)}. 
dz  or 


(16) 


The  computational  procedure  involves  first  setting  rk  and  zk  to  nominal  values  and  letting  several 
algorithm  iterations  to  take  place.  Given  quadratic  convergence  rate  associated  with  the  Newton- 
Raphson’s  method,  we  expect  fast  convergence  during  these  initial  iterations  to  take  place.  We  then 
start  varying  rk  and  zk,  letting  Xk  respond  based  on  (16)  and  letting  X(Xk,  rk,  zk),  computed  using 
(14),  track  the  minimizer.  Under  suitable  assumptions,  and  following  steps  of  showing  quadratic 
convergence  rate  for  Newton’s  method,  it  can  be  demonstrated  that  the  minimizer  tracking  accuracy, 
||Xfc— X*k\ |,  is  of  order  0(e),  where  e  bounds  |  |rfc+t_ rfc||  and  | \zk+l—zk\\,  and  where  X*k  denotes 
the  true  minimizer.  Consequently,  slowing  changes  in  r  and  z  reduces  the  minimizer  tracking  error. 
To  implement  the  algorithm,  we  take  advantage  of  the  explicitly  known  functional  form  for  F,  and 
use  the  following  expressions 


In  these  equations, 


OX 


—  =  (. P  +  \2StQS)~ 1  {-STQ(SXe(r)  -z)}, 


d\2~AS  r)  Q(5aA2)’ 


dX 


—  =  (P  +  X^QS)-1  {-5tQ,SU}  A2, 


dr 
dF 


dX 


Qr  =2  (SX-z  +  r)TQ(SXX  +  I3), 

^  =  (P  +  X2STQS)~1STQSnX2, 
dz 


Xe(r)  =  fir,  where  fl 


h 

0  ’ 
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and  I3  denotes  the  3x3  identity  matrix. 

Figure  3  illustrates  the  growth  distance  tracking  in  the  case  when  z  =  [0.3,  0.4, 0.5]T,  Q  =  IOO/3 
and  P  =  PT  >  0  is  determined  as  a  solution  to  the  Lyapunov  equation.  For  the  first  20  iterations, 
rk  is  a  constant  and  then  starts  to  vary  slowly  through  the  virtual  net.  The  growth  distance  tracking 
is  accurate.  Figure  4  illustrates  the  growth  distance  tracking  in  the  case  when  rk  varies  through 
points  in  the  virtual  net  in  such  a  way  that  the  distance  becomes  zero  for  some  of  the  points. 


Figure  3:  Implementation  of  parameter-dependent  Newton-Raphson  algorithm. 


(b)  Minimizer  tracking 


Figure  4:  Implementation  of  parameter-dependent  Newton-Raphson  algorithm. 


Extensions 

The  above  approach  considered  a  single  debris  which  remained  stationary  relative  to  the  space¬ 
craft.  Multiple  stationary  or  moving  debris  can  be  handled  with  a  similar  approach.  The  basic  idea 
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is  discussed  in  this  paper  and  will  be  developed  further  in  future  publications.  In  this  approach  a 
union  of  a  finite  number  of  sets  of  ellipsoidal  shape. 


i=nd 

V=\J  0(Zi,Qi),  (17) 

i—  1 

where  the  ith  set  is  denoted  by  Zj  e  R?  and  the  ith  set  shape  is  defined  by  Qi  =  Qj  >  0  is 
used  to  cover  the  predicted  paths  of  one  or  multiple  debris.  The  growth  distance  is  redefined  as  the 
minimum  distance  to  each  of  0(zi,  Qi),  i  =  1,  •  •  •  ,  nY/,  and  used  to  construct  the  connectivity  graph 
and  perform  motion  planning.  A  simulation  example  of  avoiding  collision  with  two  debris  will  be 
presented  in  the  next  section. 

Another  extension  is  to  incorporate  bounds  on  the  disturbances  due  to  air  drag,  solar  pressure  or 
thrust  errors.  The  main  modifications  required  arc  in  the  definition  of  the  vertex  connectivity  and  in 
the  notion  of  the  invariance  of  C(r.  K,  p*(r,  K ,  z)).  Specifically,  we  consider  the  vertex  r,  as  being 
connected  to  the  vertex  r3  if  there  exists  Kj  6  /C  such  that  for  all  K  <G  /C 

Foo(ri,K)  C  intC (r j ,  Kj ,  p* (r j ,  I\,  z)),  (18) 

where  /A  (r, ,  K)  denotes  the  minimum  invariant  set14  of  the  closed-loop  dynamics  with  the  gain  K 
and  set-point,  rt.  This  minimum  invariant  set  plays  a  role  similar  to  Xe{r),  i.e.,  it  is  the  minimum 
asymptotic  attractor  of  the  closed  loop  trajectories  under  the  influence  of  all  possible  disturbance 
inputs.  The  set  C(rj ,  Kj ,  p* {rj ,  K,  z))  must  be  positively  invariant  under  the  influence  of  distur¬ 
bances  satisfying  the  specified  bounds.  This  in  effect  imposes  a  lower  limit  on  p*{rj ,  K,  z)  and 
makes  the  case  C'fr;.  Kj,  p*(rj,  K,  z))  =  0  more  common.  However,  under  suitable  probabilistic 
assumptions  on  the  independence  of  the  disturbances  for  different  time  instants,  the  connectivity 
condition  (18)  can  be  replaced  by  the  weaker,  “disturbance-free”  condition  (12).  See  Ref.  14  for 
the  basic  approach  in  the  multimode  controller  case. 

SIMULATION 

Simulations  arc  now  provided  that  illustrate  our  debris  avoidance  approach.  We  consider  a  nom¬ 
inal  circular  orbit  of  850  km  and  discretize  the  HCW  equations  with  a  sampling  period,  AT,  of 
120  seconds.  We  construct  an  approximately  2  km  cubed  virtual  net  and  define  two  sets  of  pref¬ 
erence  ordering  for  our  LQ  gains.  We  refer  to  the  first  preference  ordering  of  LQ  gains  as  mini¬ 
mum  fuel  ordering  where  gains  corresponding  to  higher  control  penalty  and  lower  fuel  consump¬ 
tion  arc  preferred.  For  this  ordering,  we  let  Q  =  diag(  100, 100, 100,0.1,0.1,0-1)  and  R  =  p/3, 
where  p  =  2  x  109,2  x  10s,  2  x  107,  2  x  106.  We  refer  to  the  second  preference  ordering  of 
LQ  gains  as  the  minimum  time  ordering  where  gains  corresponding  to  lower  control  penalty  and 
faster  response  arc  preferred.  For  this  ordering,  we  keep  the  same  Q  and  let  R  =  p/3,  where 
p  =  2  x  104, 2  x  103,  2  x  102, 2  x  101. 

An  ellipsoidal  set  over-bounds  a  piece  of  debris,  0(zi,Qi),  centered  at  z  1  =  [0.3  0.4  0.5]T 
km  and  with  Q\  =  IOO/3.  We  use  the  fast  distance  computation  technique  based  on  bisections 
to  determine  the  growth  distance  to  the  debris  from  each  node  in  the  net.  The  spacecraft’s  initial 
condition  is  2/(0)  =  Xe(ro),  where  ro  =  [1.58  1.0  1.58]T.  The  target  equilibrium  node  is  Xe(0). 
Finally,  we  do  not  consider  thrust  constraints  in  this  simple  example.  Dijkstra’s  algorithm  is  used  to 
find  the  shortest  cost  path  from  initial  node  to  final  node. 
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Figure  5  shows  the  path  the  spacecraft  takes  under  closed-loop  control  in  order  to  avoid  the  debris. 
The  case  when  minimum  time  gain  preference  ordering  is  used  is  shown  in  Figure  5  a,  and  the  case 
when  minimum  fuel  gain  preference  ordering  is  used  is  shown  in  Figure  5b.  In  both  cases,  the 
spacecraft  is  able  to  complete  the  desired  maneuver  while  successfully  avoiding  the  debris. 


Debris  Avoidance  Path 


Debris  Avoidance  Path 


(a)  Minimum  time  LQ  gain  ordering  preference.  (b)  Minimum  fuel  LQ  gain  ordering  preference. 


Figure  5:  Debris  Avoidance  Path.  The  green  x  marks  the  initial  node,  the  blue  x  marks  the  final 
node.  The  red  ellipsoid  represents  the  debris.  The  blue  line  is  the  path  the  spacecraft  takes  in  order 
to  avoid  the  debris.  The  blue  ellipsoids  represent  the  invariant  sets  along  the  path. 


In  Figure  6  we  rerun  the  above  simulation  for  a  grid  of  initial  conditions.  The  minimum  time 
maneuvering,  shown  in  Figure  6a,  clearly  demonstrates  the  initial  conditions  for  which  the  manuever 
path  is  purturbed  from  that  which  it  would  have  taken  had  there  been  no  debris. 

Finally,  we  add  a  second  piece  of  debris,  0(z 2,  Q2),  centered  at  Z2  =  [—0.3  0.4  0.5]T  and  with 
Q2  =  IOO/3.  In  calculating  the  growth  distance,  we  take  the  minimum  distance  to  each  of  0(zi,  Qi ), 
i  =  1,2.  Figure  7  shows  the  path  the  spacecraft  takes  under  closed-loop  control  in  order  to  avoid 
the  debris.  The  case  of  minimum  time  gain  preference  ordering  is  shown  in  Figure  7a.  The  case 
of  minimum  fuel  gain  preference  ordering  is  shown  in  Figure  7b.  Note  that  while  the  “minimum 
time”  maneuver  path  is  not  noticeably  changed  as  compared  to  the  case  with  one  piece  of  debris, 
the  “minimum  fuel”  maneuver  path  is  quite  different,  as  the  second  piece  of  debris  lies  along  the 
path  the  controller  would  have  selected  had  the  second  piece  of  debris  not  been  there. 


CONCLUSION 

The  paper  proposed  an  approach  to  spacecraft  relative  motion  control  which  satisfies  constraints 
on  thrust  and  avoids  collisions  with  debris.  The  approach  is  based  on  switching  between  set-points 
in  a  virtual  net  and  maintaining  the  spacecraft  trajectory  within  a  tube  formed  by  safe  positively 
invariant  sets.  The  invariant  sets  have  ellipsoidal  shape,  and  fast  online  distance  computation  has 
been  proposed  to  determine  a  distance  between  two  ellipsoidal  objects. 

Several  extensions  of  this  approach  are  of  interest,  including  less  conservative  treatment  of  the 
case  of  multiple  debris,  and  will  be  pursued  in  future  publications. 
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Debris  Avoidance  Path  Debris  Avoidance  Path 


(a)  Minimum  time  LQ  gain  ordering  preference.  (b)  Minimum  fuel  LQ  gain  ordering  preference. 

Figure  6:  Debris  Avoidance  Path  for  many  initial  conditions.  The  green  x  marks  the  intial  node,  the 
blue  x  marks  the  final  node.  The  red  ellipsoid  represents  the  debris.  The  blue  line  is  the  path  the 
spacecraft  takes  in  order  to  avoid  the  debris.  We  do  not  show  the  invariant  set  ellipsoids  for  visual 
clarity. 


Debris  Avoidance  Path 


(a)  Minimum  time  LQ  gain  ordering  preference. 


Debris  Avoidance  Path 


(b)  Minimum  fuel  LQ  gain  ordering  preference. 


Figure  7:  Debris  Avoidance  Path  for  2  pieces  of  debris.  The  green  x  marks  the  intial  node,  the 
blue  x  marks  the  final  node.  The  red  ellipsoid  represents  the  debris.  The  blue  line  is  the  path  the 
spacecraft  takes  in  order  to  avoid  the  debris.  The  blue  ellipsoids  represent  the  invariant  sets  along 
the  path. 
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